t 


J 


Europaisches Patentamt 
European Patent Office 
Office europeen des brevets 


n 


© Publication number: 


0 394 517B1 


© 


EUROPEAN PATENT SPECIFICATION 


© Date of publication of patent specification: 30.06.93 © Int. CI. 5 : G01C 21/22 
© Application number: 89107499.9 
© Date of filing: 25.04.89 


© Vehicle navigation system. 


00 

rs 

CO 


© Date of publication of application: 
31.10.90 Bulletin 90/44 

© Publication of the grant of the patent: 
30.06.93 Bulletin 93/26 

© Designated Contracting States: 
DE FR GB 

© References cited: 
EP-A- 0 181 012 
EP-A- 0 261 404 


© Proprietor: ROBERT BOSCH GMBH 
Postfach 30 02 20 
W-7000 Stuttgart 30(DE) 

© Inventor: Kasser, Jurgen, Dr. rer. nat 
Ahornweg 5 

W-3201 Diekholzen 2(DE) 


Note: Within nine months from the publication of the mention of the grant of the European patent, any person 
may give notice to the European Patent Office of opposition to the European patent granted. Notice of opposition 
jXi shall be filed in a written reasoned statement. It shall not be deemed to have been filed until the opposition fee 
Ul has been paid (Art. 99(1) European patent convention). 


Rank Xerox (UK) Business Services 

(3. 10/3.6/3.3.1) 


EP 0 394 517 B1 


Description 

The present invention relates to navigation systems, and is particularly applicable to navigation systems 
for land vehicles. Navigation systems for use in shipping, air and space travel are well known and their 

5 benefit is indisputable. More recently, navigation systems for overland travel have met with increasing 
interest and homing systems for travel on motorways and city road systems have been proposed. 

An electronic traffic pilot for motorists is described in an article in the German magazine 
"Funknavigation", issue no. 4 of 1983, entitled EVA - Ortungs-und Navigationsystems Fur Landfahrzeuge, 
by Ernst P. NeuKirchner, Otmar Pilsak, and Dietmar Schlogl. The basic system includes a driver 

10 communications system via which the starting point and destination are entered and direction recommenda- 
tions issued; a route search system, which computes the optimum route, based on the starting point and 
destination entered, by accessing a digital illustration of the road system; a locating system which 
continuously updates the actual position during the journey and a navigation system, which makes a 
comparison of the set route and the actual route and, in the event of any disparity, causes the route search 

75 system to determine a new optimum route from the actual position. This last feature makes the homing 
always optimal, regardless of whether or not the directional recommendations are followed. 

EP-A 181 012 describes an adaptive vehicle navigation system. Position locating devices in the vehicle 
determine the vehicle's position coordinates recurrently from the speed and acceleration of the vehicle in 
motion as determined by the measuring unit. The generated vehicle position coordinates are compared to 

20 an actual route position, which are repeated by coordinates of the route network which are stored in a mass 
memory. The coordinates of the route network determine all possible routes. For getting a good reproduc- 
tion of the route many coordinates are necessary. 

The known system requires a very large data handling capability and is hence complex and expensive 
to produce. In particular a large amount of memory space is required to store the data relating to the road 

25 system. This problem is alleviated to some extent by storing map data for different areas on magnetic tape 
in a cassette. The user then selects the cassette containing the appropriate map data for the journey to be 
made. However, a certain memory capacity is required to take data from the cassette tape for use in the 
system, and therefore it is desirable to be able to reproduce a map of the area to be travelled through from 
as little data as possible. 

30 The present invention provides a method and an apparatus for determining the location of a vehicle as 
claimed. According to the invention each route is represented as a series of route sections, each of which is 
defined in terms of a set of coordinates and its curvature. 

The set of coordinates may be the initial or final coordinates of the route section. As will become clear 
from the following description, this method of representing a route network requires far less data than, say 
35 representing each route as a series of coordinates only. It will be appreciated that the method is applicable 
to navigation systems other than that described above. 

In accordance with the invention the curvature may be defined as the radius of each route section or 
the reciprocal of the radius. 

In the known EVA navigation system, the locating system compensates for errors in the vehicle position 
40 sensors, using the stored information on the route network. Assuming that the vehicle remains in the route 
network (unless it departs entirely from the mapped area) it is possible to deduce the actual vehicle location 
by comparing the calculated position values to the possible values according to the stored route network 
information. 

This error elimination can be greatly simplified if the route network is represented in the manner 
45 described above. 

It is known to monitor the position of the vehicle using a compass and it is known to monitor the 
distances travelled by the inner and outer (right side and left side) wheels. The radius of curvature of any 
route section through which the vehicle travels can be calculated either from the compass direction or the 
wheel sensors, in a manner to be described below. The radius of curvature of successive route sections 

so may be compared to the stored radius to accurately determine the actual vehicle position. Because this 
method of determining vehicle location is based on differential variables it is more accurate than known 
methods. For example, in a system which relies entirely on measurement of coordinates there will always 
be a certain navigation error. In conventional systems errors occur in particular on extended curves since 
the directional changes at the reference points do not coincide with the route followed by the road. (In a 

55 conventional system the road is represented as a series of coordinates linked by straight lines.) However a 
point of inflection (change in curvature) along a route can be determined precisely, and hence each time a 
vehicle is at such a point its position is known accurately. 
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An embodiment of the invention will now be described by way of example and with reference to the 
accompanying drawing in which: 

Figure 1 is a diagram illustrating the manner in which map data is stored according to this invention. 

Referring to Figure 1 , a length of road between two nodes A and B can be divided up into a number of 
5 arcs of a circle. It is possible to reconstruct a picture of that length of road given, for each individual arc, the 
initial coordinates (x.y) and the radius of curvature R. The coordinates of the beginning of one arc provide 
the end point for the previous arc. (A sign will be necessary for the radius R since there are two possible 
arcs of the same radius joining any two points). 

In this embodiment of the present invention, lengths of road are stored in the system in this way. Thus, 
10 for each road section three factors are stored, namely initial coordinates (x,y) and radius (with sign). 
Alternatively the curvature K = 1/R may be stored instead of the radius. This is more convenient in fact 
since curvature is always finite whereas the radius for a straight section is infinite. 

The figure shows a set of coordinates at each change in the curvature of the route. If a route section of 
constant curvature completes a turn of more than 180° it is preferred to include at least one additional 
75 reference point and store the coordinates of this point. 

The distance D between the two nodes can be calculated from the following formula: 


20 


55 


^- Ri arcsin ^ (x i+1 - Xj) 2 + (yj+1 ~ Yj) 2 


arci 


2Ri 


25 In order to reduce the effort required for this calculation the lengths of the individual arcs may additionally 
be stored so that the road distance between two nodes is simply calculated from the sum of the lengths of 
the individual arcs. 

During a journey, the position of a vehicle is monitored. In the known system described above the 
direction of travel of the vehicle relative to North is continuously monitored and pulse transmitters on the 

30 wheels provide information on the distance travelled. Any known method and apparatus for detecting the 
vehicle position can be used in the present invention. In the known navigation system, deviations between 
calculated and actual vehicle position occur due to various interfering influences. Such errors are com- 
pensated for by comparing the measured values of angle and position to the available values of angle and 
position from the stored road map. Assuming that the vehicle only travels within the stored road system, 

35 conclusions can be drawn on the actual position of the vehicle. 

With road map data being stored in the manner described above the comparison of calculated vehicle 
positions and actual available positions within the road network is very simple. The radius of an arc or road 
section through which the vehicle is travelling can be obtained from the direction of travel of the vehicle (P) 
which may be monitored by a compass, and the speed (v) of the vehicle obtained for example from the 

40 speed monitor, using the formula: 


45 Vdt/ ds / 


With s being the distance travelled. 

Alternatively the radius can be calculated from the signals given by the wheel sensors, using the 
so formula. 

R = ^ ( Si + S ? ) 
2 (Sj - S 2 ) 



Where A is the wheel separation, Si and S2 are the paths of the outer and inner wheels and R relates to 
the axle centre. 
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The radius can also be used for dead reckoning navigation, for example at a node or junction where a 
number of routes are available. The calculated values of vehicle position and radius of route section are 
compared to the stored values to determine which of the available directions the vehicle has taken. 

The present invention is particularly useful for determining the location of a vehicle when it enters a 
5 mapped area from an unknown approach location. If the vehicle departs from a mapped area the sensors 
continue to monitor for example, the orientation of the vehicle and the distance travelled, so that the 
coordinates of the vehicle can always be calculated. However, because the calculated data is not 
continuously correlated with stored map data, errors build up so that by the time the vehicle re-enters the 
mapped area there is no precise information on the point of re-entry. The farther the vehicle travels outside 
70 the mapped area, the greater will be the error in the calculated location when the vehicle re-enters the 
mapped area. 

The navigation error can be calculated from the distance travelled and used to define an area of 
possible locations of the vehicle. By correlating the measured arcs with the stored arcs possible in the 
range of dispersion, i.e. the defined area, a correlation maximum is obtained for the actual distance travelled 
75 whereby the location of the vehicle is determined. 

One possibility for accumulating the measured data is to store the route curvatures for equidistant 
points along the route travelled, beginning from when the vehicle enters the mapped area, using the on 
board sensors and taking tolerances into account. 

Starting from the radius at possible entry locations the stored arcs travelled are compared to the 
20 mapped arcs. Sections with very minor coincidence are eliminated and from the possible routes the one 
which corresponds most closely to the measured (stored) route is taken to be the actual route. 

If very distinctive changes of direction occur during entry (i sections with small radius) the correlation 
can be arranged on the basis of these curvatures. 

In conventional navigation systems it is known to use a compass and wheel sensors to complement 
25 each other since their error mechanisms are different (wheel sensors have good short-distance stability, a 
compass has good long-distance stability). This method can be easily applied to the present invention 
based on radii or curvature of route sections, because the curvature is directly available as a measured 
value. If, for example, the curvature provided by the compass is for a short time very much greater than that 
of the wheel sensors, there is presumably a magnetic interference and the wheel sensors are providing the 
30 correct valve. If, on the other hand, by integration of the angle increments 

d = dtS! - S 2 ) 

35 

a value is obtained which deviates from some time by a constant angle from the compass indication, the 
compass is correct. 

To navigate a vehicle in accordance with the present invention it is not essential for radii or curvature 
valves to be continuously monitored outside a mapped area, and thus any conventional composite 
40 navigation method may be used outside the mapped area. 

If a vehicle generally travels in regions for which a map is stored in accordance with the invention, it 
may be possible to dispense with the compass and rely on the wheel sensors alone. The reason for this is 
that unlike systems which utilise the direction of travel, which has to be obtained by integration of 
increments of changes in the direction of travel (summation of a systematic error) the measured valves 
45 provide the radius of curvature directly. Thus there is less likelihood of large errors occurring and less need 
to use the compass as well. 

Claims 

so 1. A method of determining the location of a vehicle in a route network, 

comprising the steps of: storing data representing available routes for the vehicle;, monitoring the 
location of the vehicle by means of one or more sensors to provide calculated location data; and 
comparing the calculated location data with the stored location data to determine the actual location of 
the vehicle; characterised in that each available route is represented as a series of route sections each 

55 of which is defined in terms of a set of coordinates (x n , y n ) aind its curvature (Ri , Rs). 

2. A method as claimed in claim 1 in which signals from the or each sensor are used to calculate the 
curvature (Ri, Rs) route sections along which the vehicle travels and the calculated curvature values 
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are compared to the stored curvature values to determine the actual location of the vehicle. 

3. A method as claimed in claim 1 or 2 in which the orientation P of the vehicle as monitored and the 
radius of curvature of each route section R is determined using the formula 

5 

R = v | dP^ -1 or R = ^ 3P j -1 

10 

where v is the speed of the vehicle and s is the distance travelled. 

4. A method as claimed in claim 1 or 2 in which the paths of the outer and inner wheels of the vehicle are 
separately monitored and the radius of curvature R of each route section is determined from the 

is formula 

R = A ( SI + S2 ) 
2 ( SI - S2 ) 

20 

where A is the wheel separation and S1 and S2 are the paths of the right side and left side wheels 
respectively and R relates to the axle centre. 

25 5. Apparatus for determining the location of a vehicle in a route network comprising: 

memory means storing data representing available routes for the vehicle, sensor means for 
monitoring the location of vehicle to provide calculated location data, and comparison means for 
comparing the calculated location data to the stored data to determine the actual location of the vehicle, 
characterised in that each available route is represented in the memory means as a series of route 

30 sections, each of which is defined in terms of a set of coordinates and its curvature. 

6. Apparatus as claimed in claim 5 in which said sensor means continuously monitors the orientation of 
the vehicle in use, further comprising means for calculating, from signals provided by the sensor 
means, the curvatures of route sections through which the vehicle travels, said comparison means 

35 being arranged to compare the stored curvature values to the calculated curvature values to determine 
the actual location of the vehicle. 

7. Apparatus as claimed in claim 5 in which in use said sensor means monitors the paths of the right side 
and left side wheels respectively, further comprising means for calculating, from signals provided by 

40 the sensor means, the curvatures of route sections through which the vehicle travels, said comparison 
means being arranged to compare the stored curvature values to the calculated curvature values to 
determine the actual location of the vehicle. 

Patentanspriiche 

45 

1. Verfahren zum Bestimmen der Lage eines Fahrzeugs in einem Streckennetz, 

umfassend als Schritte: Speichern von Daten, die fur das Fahrzeug verfugbare Strecken darstellen; 
Uberwachen der Lage des Fahrzeugs mit Hilfe von einem oder mehreren Sensoren, urn berechnete 
Lagedaten zu gewinnen, und Vergleichen der berechneten Lagedaten mit den gespeicherten Lageda- 
50 ten, urn den tatsachlichen Ort des Fahrzeugs zu bestimmen, dadurch gekennzeichnet, daB jede 
verfOgbare Strecke durch eine Reihe von Streckenabschnitten dargestellt wird, von denen jeder durch 
einen Satz Koordinaten (x n , y n ) und seine Krummung (R lf FU) definiert ist. 

2. Verfahren nach Anspruch ist, bei dem Signale vom Sensor oder jedem Sensor zum Berechnen der 
55 KrOmmung (Ri, Rs) von Streckenabschnitten, die das Fahrzeug befahrt, benutzt werden, und Vergleich 

der berechneten Krummungswerte mit den gespeicherten Krummungswerten erfolgt, urn die tatsachli- 
che Lage des Fahrzeugs zu bestimmen. 
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3. Verfahren nach Anspruch 1 oder 2, bei dem die Orientierung P des Fahrzeugs uberwacht wird und 
Bestimmung des KrUmmungsradius jedes Streckenabschnitts R mit der Formel 


R - v (dP) " 1 oder R = IdPl" 1 
(dt) (ds) 

erfolgt, wobei v die Geschwindigkeit des Fahrzeugs ist, s die Fahrtstrecke. 

4. Verfahren nach Anspruch 1 oder 2, bei dem die Wege der auBeren und inneren Rader des Fahrzeugs 
gesondert uberwacht werden und der Krummungsradius R jedes Streckenabschnitts mit der Formel 

R = A (S x + S 2 ) 
2 (S x - S 2 ) 


bestimmt wird, wobei A der Radabstand ist, S1 und S2 die Wege der rechten und linken Rader sind 
und R sich auf das Achszentrum bezieht. 

5. Vorrichtung zum Bestimmen der Lage eines Fahrzeugs in einem Streckennetz, umfassend: 
Speichermittel zum Speichern von Daten, die fur das Fahrzeug verfugbare Routen darstellen, Sensor- 
mittel zum Uberwachen der Lage des Fahrzeugs, urn berechnete Lagedaten zu gewinnen, und 
Vergleichsmittel zum Vergleichen der berechneten Lagedaten mit den gespeicherten Daten, urn die 
tatsachliche Lage des Fahrzeugs zu bestimmen, dadurch gekennzeichnet, dafi jede verfOgbare Route in 
den Speichermitteln als eine Reihe von Streckenabschnitten dargestellt wird, von denen ein jeder durch 
einen Satz Koordinaten und seine Krummung definiert ist. 

6. Vorrichtung nach Anspruch 5, bei der die erwa'hnten Sensormittel die Orientierung des fahrenden 
Fahrzeugs fortlaufend Uberwachen, auBerdem mit Mitteln zum Berechnen der KrUmmungen von 
Streckenabschnitten, die das Fahrzeug befahrt, aus durch die Sensormittel gelieferten Signalen, wobei 
die erwahnten Vergleichsmittel so gestaltet sind, dafi sie die gespeicherten Krummungswerte mit den 
berechneten Krummungswerten vergleichen, urn die tatsachliche Lage des Fahrzeugs zu bestimmen. 

7. Vorrichtung nach Anspruch 5, in deren Betrieb die erwahnten Sensormittel die Wege der rechten und 
linken Rader uberwachen, auBerdem umfassend Mittel zum Berechnen der Krummung von Streckenab- 
schnitten, die das Fahrzeug befahrt, aus von den Sensormitteln gelieferten Signalen, wobei die 
erwahnten Vergleichsmittel so gestaltet sind, daB sie die gespeicherten Krummungswerte mit den 
berechneten KrOmmungswerte vergleichen, urn die tatsachliche Lage des Fahrzeugs zu bestimmen. 

Revendications 

1. Proc6d6 pour determiner la position d'un vdhicule sur un r^seau routier comprenant les Stapes 
suivantes : 

la mise en m£moire de donndes repr£sentant les itine*raires possibles pour le ve*hicule, le controle de la 
position du v^hicule au moyen d'un ou plusieurs capteurs servant a fournir les donnees calcul^es de 
position, 

et la comparaison des donne*es calcul£es de position aux donnees mises en m^moire de position pour 
determiner la position reelle du vghicule, 

procede caracterise en ce que sur chaque itineraire disponible, on a repr^sente* une serie de sections 
d'itineraires, chacune etant determin§e sous forme d'un peu de coordonn^es (xn, yn) et de sa courbure 
(R1.R6). 

2. Proc6d6 tel que revendique* dans la revendication 1 , dans lequel les signaux provenant du capteur ou 
de chaque capteur sont utilises pour calculer la courbure (R1, R6) des sections d'itineVaire que le 
v§hicule parcourt et les valeurs calculSes de la courbure sont compares aux valeurs de la courbure 
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mises en memoire pour determiner la position reelle du vehicule. 

3. Proc^de tel que revendique dans les revendications 1 ou 2 dans lequel I'orientation P du vehicule telle 
qu'elle est controiee et le rayon de courbure de chaque section d'itineVaire R est determine en utilisant 
la formule suivante : 

( dP \ -1 n / dP l-l 

dans laquelle v est la vitesse du vehicule et s est la distance parcourue. 

4. Procede tel que revendique dans les revendications 1 ou 2, dans lequel on controle separement les 
75 trajets des roues exteVieures et interieures du vehicule sont controles separement et le rayon de 

courbure R de chaque section d'itineVaire est determine a partir de la formule suivante : 


70 


20 


25 


= A (SI + S2) 
~ 2 (SI - S2) 

dans laquelle A est I'ecart entre les roues et S1 et S2 sont les trajets respectivement des roues du 
cote droit et des roues du cote gauche et R se rapporte au centre de I'essieu. 


5. Appareil pour determiner la position d'un vehicule sur un r£seau routier comprenant une memoire 
enregistrant les donnees repr£sentant les itin^raires disponibles pour le vehicule, des detecteurs pour 
controler la position du vehicule servant a fournir les donnees calculees de la position et des moyens 
pour comparer les donnees calculees de la position aux donnees mises en memoire pour determiner la 

30 position reelle du vehicule, appareil caracterise en ce que chaque itineraire disponible est represent^ 
dans la memoire sous forme d'une s^rie de section d'itineraires, chacune de ces sections etant definie 
par un jeu de coordonn^es et sa courbure. 

6. Appareil tel que revendique dans la revendication 5 dans lequel le capteur controle de fapon continue 
35 I'orientation du vehicule utilise, en outre comprenant des moyens pour calculer, a partir de signaux 

fournis par les capteurs, les courbes des sections d'itine>aire parcourues par le vehicule, les moyens 
de comparaison etant congus pour comparer les valeurs de courbure mises en memoire aux valeurs de 
courbure calculees pour determiner la position reelle du vehicule. 

40 7. Appareil tel que revendique dans la revendication 5, dans lequel le capteur en service controle 
respectivement les trajets des roues du cote droit et des roues du cote gauche, comprenant en outre 
des moyens pour calculer, a partir de signaux fournis par le capteur, les courbes des sections 
d'itinerairo parcourues par le vehicule, les moyens de comparaison etant disposes pour comparer les 
valeurs de courbure emmagasinees aux valeurs de courbure calcuiees pour determiner la position 

45 reelle du vehicule. 
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